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force-fkedbXck: Aje:BmcA!rioi<tB 

aREFERENCB TO HEL ATBD ji^JPEXJCAaaONS 

^ This iaventlon daliii^ prioiib^ of XJjS^ Provisional Appli- 
cation. Sedal No, 60/005,861, fiied Oct 26i 1995, the entire 
contents ocf which are incoipocated hearehj by retfcierice.^ 

HIEIJD OF THE INVHtm 

■ The present invention relates genqjally to f offce f6edbac3c 
and, niore particularly, to the use of gyroscopic stabilization 
to mrovide an hxcrtial j^raxne agamst which a force-rcflcctiug 
device react. ' ; " ' 

. B ACKOROTiKD OF THE IKVENTEOK 

Farce-fiaedbacifc technology and related devices ^iiay be 
divided into four broad application areas: medical, 
entertainment, teleopcrations, and virtual reality. 
TeleopciationB, the research* of wMch provided the founda-r 
tlon for the development of fcirce-jfeedbaclc devices^ is the 
process of locally contraUing a remote device. The primary 
differcnpe between virtual reality and telcopcratiotts is in the 
objects which they cocitrol. Witii teleoperatibas, actual 
physical robots are manipulated in. the rei world, whereas 
virtual reality involves simulated devices in synthetic 
worlds, Farcci-feedback for telerobotics has evolved large 
and buli^ mechanical arms to more joystick-like designs. In 
.:gencxal, these devices are designed far six degree-of.- 
j5reedom jC6DOF) force feedback^ and have the capability to 
provide high levels of force. More recehfLy, .fLngca:-ol>crated 
devices have also been introduced for use in teleoperations 
applications, 

llie use of force feedback in medical training, simiilation» 
and toleoperations is also increasing, with the priroaiy 
application being minimally invasivo surgical techniques 
which nee Is^axscopic tools to pcrf arm intcic^-tc tasks when 
inscccted into body cavitiefl through small incdsioas* To 
realistically simulate, laparoscopic tool forces, special- 
purpose force-feedbadk devices are cujxKntly iinder devel- 
opment. 

. The entertainment field is very difficult to address with 
force^fecdback tcchncdogyy sincD the applications dean and 
both hi^GT pecfcuxaance and lower costs* There are. three 
pimiary markets for force feedback devices in' entertain- 
ment: location-based entertainment (IJSE), arcades, and 
home entertainment LBE demands the highestpsrfarmanco 
while home 'entertaijamcnt demands the lowest cost. Despite 

■ the-confiicting demands^ progress 'is being made in each of 

• these fields. 

It 'may be argued that each of the application domains just 
described has its roots in virtual reaUti^, which is becoming 
dominant in all immcrfiivc appUcatians. Ae a consequence, ' 
on-going research in imtocrsiye -applications is oftea termed 
'Virtual reality," v?hcreas, when the research is conapleted, 
the application is given a specific name, such as a surgical 
simiilatarl Overall, virtual reality is becoming increasingly 
ipapiilar as a preferred means of interacting with many 
. scientific and engineerihg applications. To dte two of many 
cx.ainples, molecular ruodeUng and automobile design arc 
moving from standard graphics, carried out on conventional 
graphics terminals, to more interactive environments utiliz- 
iixg 3-D stereo graphics^ hcad-moahtcd displays and force 
feedback. 

As- visualization is a very important aspect of; these • 
applications, intqresting and useful technologies are being 
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developed, iududiiig ^capliical object xeprescntatioas and 
large woddng voliimes (CAVfiS). Concurrently, hapttc 
interfaces are being pec&cted, wliioh enable manual inter" 
aciioiis with yirtpai environments or tdeqpcratcd remote 

5 systems. The baptic system is a unique sensory system in 
that it can both sense the envirdmnent and allow a user to 
react accordingly. As -a' result, haptic devices not- only 
stuniilatc the user with realistic sensor input (forces* tactile 
sensations, heat, slip, etc.), but also sense the nficr*s actions 

10 -so that realistic sensory inputs -can be generated. Eteptic 
devices are divided into two classes, depending upon the 
type of BGDSG^ infnrrnntiQn being simulated. The first, 
tactile, refexB tb the sense of contact with the object. The 
second, IdnesthefiCy refers to the sense, of position and 

15 motion of a user's limbs along with associated forces. 

Broadly, these approaches -point toward the same goal: to 
immerse a pcarson in a seemingly visual reality, complete 
■ with haptic feedback. However, a naj^or ddadency with all 
esdstiag.- force-gencratiBg devices is the .requirement that 

20 -they be connected tb a fixed frame, thus forcing iromobUity 
on ttie XLsct StateHDcf-thcr-art forcc-fecdbadc devices, for 
example, arc table mounted^ requiriug the device to be 
mounted to an immobEe object in order to generate a fixed 
point of leverage for farces and/or torques. Consequently, no 

25 existing force feedback deyico allows for easy mobility and 
force generation- This paroblem is fondamentalj. since many 
virtual neaHty applicaticns require large wcarMng volumes 
and the atoliiy to move £ceeiy within these volumes, to 
provide realistic visual and audio feedback during walk- 

30 tbroagix scenarios, for example. 

In summary, large, immersive environments such as 
CAVES currenliy lack haptic feedbadk, primarily because 
tbe existing technology will not support umcstricted motion. 
This leads to one conclusion that fojrce-feedbaclc devices 

3^ must paigrate as visual technologies have, diat is^ from the 
desktop to large- volume, immersive environments. 
However, the design of a hand-held, spatially unrestricted 
f arccrfecdbacik device is fijudamei^tally different from exist- 
ing devices, which typicaUy use primarily electroinechanlcal 
or pneumatic actaators operating agaihst fixed supports to 
achieve active force feedfaacik. Nor is the realization of such 
a dcfvice intuitively obvious. To coustruct an n-axis joystick, 
requiring 1, 2, 3 • to n-h3 motors, presents significant 
challenges, for example, since tihe additional xaotore may 

^5 . significaittly increase the cost and/oi: weight of ibe device. 

StlMNlAJRY* OF THE DSr^^ 
The present invention addresses the need for force feed- 
back in large, imrneisive environments by providing a 

50 device that uses a gyro^stabiliz:atlon to generic a fixed point 
of leverage for ihc requisite farces and/or torques. In. one 
embodiment, one or more . orthogonally oriented rotating 
gyroscopes are used to provide a stable body or platform to 
which a force-refLectihg device can be mountad, thereby 

55 cot^iing reaction forces to the user without the need for 
connection to, a fixed fetme. In one embodimeait, a user- 
ixitexactablfr member is physically coupled tb a stabilized 
body, with" the control sfccucture used for stabilization and 
that used to mitigate farce-feedback being substantially 

60 iiidependent of one another, enabling different stabilizalion 
mLechanisins as desccTbed herein to be used witih existing 
force-feedback capabilities. In altea^ative embodiments, 
inventive apparatus and niethods are used which take into 
account bofii the movements associated with the gyroscopic 

65 stabilization, a user's movements, an4 the application of 
torques and forces to realize a spatially unrestricted force- 
fcedbaclc device requiring fewer motors and structural cle- 
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uxontB. Specifically, wi iQventive cotitrol scheme is used in t 
thcss^ c&ses to accelerate and decdexate the motor(s).^asso- ! 
ciated.xyiih providing the gyroscopic stabilization such that 
onljr the desired tactile feedback: is expeadenced by the uscx. 
An of the various approaches are applicable to single and 
multiple degrees of freedom. 

A three-axis impleiiientatioii includes a set of three, 
mutually perpendicular momentum wheels which fprm the. 
gyro-stabilized platform, an attitude measuring devjce^ and 
a control system The attimde measnndng device is employed 
to detect disturbances to the gyro-stabilized platfoxna, ' 
including reaction torques due to a user's interactjqne with 
theijdevice. The control system varies the speed the momen- 
tum wheels in order to TT>ninr.aiT^ the gyro-stabdlized platform 
in a ibted position. In an alternative ercibodinicnt, axeactipn 
epliere is used to produce tiie requisite inertial stabilization. 
Since the sphere is capable of providiag controlled torgoes 
about three arbitrary, linearly independent axes,, it can be 
used in place of three reaction wheels to provide three-axis 
stabilization for a variety of space-based and tcprcstcxal 
applications. 

3RIEF DESCfaFnOK OF THB DIRAWINGS ; 

KCGi i is fL drawing of a one-dimensional space gjnco- 
' scqpic model, as seen from an oblique perspective; 

KfG- 2 is a drawing of a. three-axis stabilized system 
model, as seen from -an oblique: perspective; 

. PIG. 3 is a drawing used to Hiustcatc torque generation 
with respect to a momentum sphere; 

FIG. 4 is a block diagram illustrating a closed-loop 
control system; , 

FIG. 5 is a block diagram illustrating a closed-loop 
control system with disturbance; 

FIG. 6 is a blocic diagram depicting plant feedback: with 
optimal feedback for linear regulations; 

FIG- 7 is a representation of a matbcTngtical model of a 
1-I> model plant; . ' . 

FIG* 8 is a state diagram used to illuBtrate position 
regulation of a 1-D satellite plant using pole placement; 

FIG: ? is a state diagram used to Illustrate a final design 
of a 1-I> satellite model controllear; 

FIG. 10 is a skeletal representation of momentum sphcare 
housing; ' . " . 

FIG- n is a simplified drawing of an aspect of a inaomen- 
tum sphere depicted infiraxed cmittsxs and dotcctors; 

FIG. 12 is a simplified drawing showing a great drde 
baud of re^ectrve material around a momentum sphere; 

FIG. 13 Is a drawing, seen from an oblique perspective^ 
illustrating a diScrent aspect of a momentum sphere; 

FIG. 14 is a cross-sectional view of a tpomentum sphere 
illustrating how a control subsystem naay intcar^ct with 
optical emitters and a reflective band; 

FIG. 15 is a block diagram used to describe a momentum 
sphere control crcvixoamcat; 

FIG, 16 is a drawings as seen team an oblique perspective, 
of a spacecraft including a pitch momentum wheel; 

FIG. 17 is a simpliified drawing used to iUustrate the 
stabilization of a gimbal sensor platform; ^ 

FIG. 18 is a block diagram of a siu^e^axis momentum 
wheel for tccrestcial applications; 

FIG. 19 is a drawing of a momentum wheel viewed from 
a top-down perspective, before the application of motor 
current; 
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'BlO. "20 ie a drawiflg of a momentum wheel aftey ttio ' 
apptUcation of jrLotor cubrcait; ^ . 

FIG* ^ is a root4ocua plot; 

FIG. Z2 a tiroe-xesponse plot of a one^dimensional 
^ matotr applicatioii according to lite invcntioa; 

* FIG. 23 is a graph used to lUustcate the contxol cffioErt of 
a 1-p motor;. 

FIG. ^ i:^ -a drawing, as seen £:om an oblique pearspcclive, - 
10 of a hand-^eld force-feedbads: cdntroUea: iitflizuig tJiree 
momentum wheels to provide iaexHal stahfli'zfttxoa in three 
space:. . 

FEG. 25 is a fixawiag of a bJock diagram of a spatiaBy 
unrestxictcd force feedback controller utflizioig three 
' 15 mamentum wheels to provide inertial stahflization in three 
space. ■ 

DEH ATTJBD DESCRiraiON OFTHE 
PKEFHRRED EMBOP3MEm*S 

'20 Accofding to the irtvcntion, progrnTntned amoimts of 
r"*^ rotary fqtrce axe u&ed for inotion compensating and/or the 

'^^ gtf'^rtliy- ritin n of firee-flying platfarnxs, or to provide force/ 

. ' . torque outputs from platfbmis to attached frames. Speciiic 

f embodiments ' are disclosed with respect to spacecraft 
rf\ '25 stabilization, as wcill a& to the application of forces and/or 

torques to hand-held force generating devices, including 
joysticba. steering -whecls» . and implements of aibitrary 
sh^e fee specific applications, such as sports simiulations. 
By way of introdnctLon, leactioa wheels use the inealia of 
one or more, (typically np to three) rotating fiywhccls to 
generate torques. These wheels are typically . accelerated 
using electric motors which can be controlled to increase or 
decrease rotary speed, thus changing rotatLonal naomentum- 
When the wheel on a particular axis xs accelerated throu^ 
increased motor torque, ,an equal and opposite reaction . 
torque is generated and applied to the base upon which the 
wheel is mounted. ^ . ' 
- .' Reaction wheels are the most precise type of attitcide 

control mechanism. Hocwevcr, when called upon to provide 
non-cychc torques, they xiciust be periodically uniloadcd by 
other meaus (Le, when the motors have accelerated to 
maximum !RPM in aiiy direction, no additional acceleration 
can be realised in that direction unless the motors are 
slowed^ generating torques in the opposite direction). 
Mareovesr, to provide arbitrary torques, three wheel axes 
must be provided. 

This application describes how reaction wheels as cur- 
rently only applied only to spacecraft can he extended into 
50 several oaicx related terrestrial applications, including gyro- 
stabiHzed bodies and tethered, force-generating/reflective 
input devices. Preliminarily, the fcUowing description will 
demonstrate and how three ajtos of reaction wheel can be 
reduced into a single, reaction sphere, useful cither in the 
55 space-based or tcnrefitiial applications < A description of 
reaction wheels and spheres will first be presented, followed 
by a discussion of the extensions to such technology made 
possiblp by the invention. 

Single Plane of Torque Action 
60 , • , , . 

. . The single plane model for a torquer consists of a spinning 

wheel attached to a firame. There is a reference frame, B, 
embedded in the frame and afixedrcf exence fetme, A, in the 
world. Kefcarenc© frame B is aligned with the axis of the 
65 spiniaing wheel. The system is shown in FIG, 1* 

The reference frame B has two degrees of freedom with 
respect to xef erence frame A- These degrees of freedom are 
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descaibcd'by gcncxaiized coardLnates q^i, where rep^. 
xesents ths. azighlar degree of freedom about unit vector aj 
and q^. represents the Imear degree of freedom along unit 
vcctca: a^. With, this model, the unit- vectors In frames A and 
.B are related by 



The center of mass of the frame is located at the OiEigia of 
the B reference frame. Tlie frariie is assumed to be a cube 
wif^j^a mass of M and height of R. 

The location of ttic center of mass of the" wheel, d, is givent 
by the vector p**, 

'p^,\ (2). 

where 1 is the offset from the center of the frantie' Chi 
meters) and is a rua-Ume parameter. The iiotatLo?^ "S^ 
denotes some vector v in reference frame B with respect to 
reference frame A. The mass, of the (assmning without loss 
of generality a solid cylindrical disk) wheel is given by 

. where p is the density of the material of the wheel, r is tiie 
radios of the disk and h is the height of the xyheel; and have 
the units, of kgtei^^ meters and meters, respectively. 
The central inertia dyadic of the wheel is given by 

where 

' . «r= " ' (5)1 

— — , - . r 

- The orientatton -of liie wheel with respect to the frame is 
given by the generalized , coordinates q^* This generalized 
coordinate is abotrt the bi axis. 

The central inertia dyadic of the fraiae is given by 

where (asstiming without loss of generality that the frame 
is cqbic) 

Since thiexe are two rigid bodies in this model (the frame 
and the wheel), the angular vclociticB aiid accelerations for 
• both must be developed* 

The reference frame B is said to have a simple angular 
velocity in the reference frame A because there exists for all 
thue a unit vector whose orientation in both the reference , 
frame B*and reference frame A is independent of time. ThiB I 
allows writing the angular velocity of reference frame B as 
ttie rnagnitude of its angular velocity times the fexed unit 
vector- 



rpfj^fft the equations of rootioa concise, a generalized 
velocity will be defined as ^ 
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Using thp defimtion iiL Equation (S), '^CQ^ can be lewrittoii 



The wheel, is said, to have a eiinplB angular velocity in' the 
reference i^ame B' because there exists fox all time a unit 
vector whose oaientalion. in both the wheel xcfcrcnce frame 
and xeference frame B is independent of time. This allows 
■wiiting the angular velocity of the wheel as the magnitude 
of its angular velocity times the iixed unit Vector 

. The angular velocity of the wheel in refeacenco teme A is 
given by 



20 -^COT'kCwi-I^t^i- ^^^^ 

• Defining another generalized velocity. 



rfl 25 ^^^^ 



allows fixpressiag Equation (12) in terms of generalized 
velocities only as 

rS The angular accelcxatioh of reference fcame B is found to 

be . 



35 

and the angular acceleration of the wheel can be written 

as - • . 

40 

^^Ui+ih>l* ^^^^ 

The location of refereiice frame B ie given by 

45 • 

The velocity ^S?^ and acceleration ^a^ of this feame are 
- found to.be 
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since the unit vectors a^. are feed in reference frame A. 
Defining a generalized velocity 



allows rewriting Equation (IS) as - . 



By deaaning tii& diatorbance forces anting at the origin of 
reference frame B as 

65 
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the distarbance torquo acting on the fraxoB as 



and the motor torque, applied to the wheel, as * ■ 

Tj^J^i . (23) 

ttie equations of motion are found to "be: 

•c^/2di+4*JT>=0 ^ (24) 

Rewriting Equation (24) in matrix farrii yields 



[r- ;][:]-[:]■ 



To control this system, an expression for i;^ that allows the 
system to move from any value of { q^ ]- to any other value 
of "Cqi^u^} in the presence of disturbance torques T^imust be 
developed (fiec Section b«d.ow)* To- gain a* pndcrstanding of. 
the system, first set 'V=0. Equation (25) can now be written 



-c^aUj^O. (26) 

From control theory* it is known- that this equation Is not 
stable since tlie poles He on the imaginary axis. Thus, the 
form of required to satisfy stability cxiterLa iaust meet the ' 
following, two critena: 

1. It must move the poles of Equation (26) into the 
left-half plane. 

' 2. It should utilize values of {qj, n^, q^, n^} to control tbe 
system as tfaese state variables can be measiirecL 

If the disturbance torque is not set cqnal to 2cro» then 
Equation (26) is rewixtten as _ 



and a third rcquircmjent for the control torque is added: ■ 
3. It must be robust for a speciaed set of disturbanca 
torque values and functLonal forms. 

■ -Some simple relationships are also developed to suggest 
appropriate motor parameter values and sizes for the 
monientmrL wheels. For real world applicatioru it is impor- 
tant to be able to specify certain aspects of the problem^ such 
as force produced, ttie p eadod of time for which it is produced 
and the mass, of the device. Also/ to gtay firmly "rooted in, 
reality, it ds important to specify the power output of tiie. 
motor. 

• Equation (2S) shows the basic equations 



whearc I is the moment of ineatia of the TnoTncTitum wheel 
(assuming that itis a thin hoop; for a solid disk. I=imr^/2 and, 
in reality, the actual value will faB. some place in between), 
mis the mass of the momentuni wheel, x is the radius of the 
niomentum wheel, % is the torque applied to the operator 
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(which is ?the Bamc as* the. torque pibduce by the motor)^ 
• is liic angular ^ccdLexatioii of ttic iiiCEiii&nniiii^hccI> go is the 
-angolar vdlbcity of tiip, mpinejatmrirwhecl, tie tbopexiod of 
timg for which the torque is ielt and F is. the powex output 

5 ofthemotoE. . - . 

To feel 4i torqiie produced by a motor that is not attached 
to' some fixed structure, the xuotior rotor must b© accelearatmg. 
The rotor will conttiiue to accelerate iintii the lootor reaches 
its maximnim augolar velocity, a value that is detcxmined by ^ 

10 motor parameteis (but the calculation of which is not 
impcntaut for this analyaifl). To incarease the amount of time 
during which the torque can he fejU, it is necessaiy to slow 
down the angular aceeleration CEf the motor by increasing the 
moment of inertia of ^e rotor. 

15 Bquation (28) has foinr equations and eight parameters. Of 
these paraTTigtgrs, an equation is fanned that relates irL;c;t,T 
and P because these are the parameters that can be controlled 
dudng the design of tlie device. One such form oi this . 
equation is 
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Aibitraiy Torque Generatioii From Wheels 



To generate arbilrary torques, a 3D platform conslsthig of 
three spinnmg wheels attached to three non-^coplanar-axes of 
a :&am& is required. (For simplicity, and without loss of 
generality^ this work assumes that fh& axes are mutually 
3Q perpendicular.) There is a reference frame, B, erobedded in 
' .the frame and a fixed refercuce &ame. A, in the world. 
Reference frame -B is aligned with the axes, of the three 
spinning wheels, thus defining a set of mumaliy pecpendicu- 
lar unit vectors. Tlie system is shown in FIG.. 2. 
25 The reference frame B has six degrees of freedom with 
respect to reference frame A. These degrees of freedom are • 
described by generalized coordinates qi, . • . , q^, where q^, 
, , ^ qg represent the angular degrees of freedom about unit 
vesctors a^ ,3^,33 respectively and . - . , represeat the 
4Q linear degrees of freedom along unit vectors ai,a^,a3 respec- 
tiveiy. The orientation of reference frame B with respect to 
reference frame A -is described using a Body 3; 1-2-3 
representatibn. Table 1 shows the relationship between the 
uidt vectors a^, and h^^ b^, b^. 
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52 The terms c,,s^ are de^ed as cos (qy) and sin (q^ respec- 
tively 

To simpltfy some expressions, the following terms are 
defined: 

60 Z1BC3C3 Zt!S-C2<3 27^*3' C^D) 

Since the equations of motion will be dfcveloped using the. 
65 unit vectors in reference frame B, the unit vectorfi in 
reference frame A are expUcdtiy presented using the t erms 
defined in Equation (30), 



For siinjMcity, and vdthout loss of generality, ttie ceater of 
nmsB of ttc framfi is located at the origm of the B rcficrcacc 
feamc and the frame is assnmcd to be cubical with a mass of 
M axid hei^t' of R. 

The central inertia dyadics cf the frame is ^ven by 

•ill I^^t^bihi'kIet2b:»^Xiib3bs 

where 
id » . ^ 

The locatioas of the center of inass of the wheels, dj, arc 
given by the vectors p'^S where 

*p*==i£'i *p*=t^ 

where. 1 is the offset firom the center, of the frame (in 
metexs). The mass of each whed. <assuiniag without loss of 
gBpearality lliat each wheel is a solid cylinder) is given by 



(35) 



Where p is the density of the mateadal of the wheel, r is the 
xaditis of the :aak and h is tlae height of the wheel and have 
the linits of kg/m^, meters and raeters respectively. 

The central inertia dyadics of the wheels are given by 



where * 

^,«Jn£3^yjau j,«J-L U=.J^^H, (37) 

The oiientation' of the wheels with respect to the frame are 
given by the generalized coordinates . - - , These 
generalized coordinates are about the bi, b^, b^ axes respec- • 
tlvdy. 

Since there are four rigid bodies in this model (the frame 
and Ihe three wheels), the angular velocities and accelera- 
tions for aU four mnst be developed. 

The angular velocity of the frame, -^CjI* is found to be 

To rpnT^-fc the cqnations of motioa concise, thx&c gcrwaral- 
izcd velocities will be defined as , " 

. Using the dcJuiition in Equation (39) ^co^ can be rewritten 
as 

The wheels are said to have a sinaple angular velocity ini 
the reference frame B because there esdsts for aU fime a unit! 
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vcctcff' whose orientadon in both the wteel reference fc^^ 
. and rdf excncc frame B is indcpeiident of time This allows 
^Vxitiiig thp angular velocities of the wheels as the inagmtudc 
of their angular velocity times the fixed unit vector 

' 5 ■ . . 

*a>''?=g76, -"oO^afca ^ci^^=:;^s^. (41) 

The angular velocities of the wheels in reference framje A 
are given by 

Defining three more generalized velocities, 

* . " * ■ " 

20 . 1^=4.7 '"a'^^B ^Sp=4fi 

^ J ' . . . . 

allows expressing EquafiLon (42) in terms of generalized 
f 0 velocities only as 



' The angular acceleration of ref exence feame B is found to- 



be 



ru ■ . 35 
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The angular accelerations of the wheels can be wrlttch as 
The f oliowing terms are deemed to siinpUfy the equations. 
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50 thus allowing Equation (46) to be rewritten as 
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There are ifour points of interest in this problem: the 
Ipcation of reference frame B and the locations of the centers 
60 of mass, for eadx of the wheels. The location of reference 
frame B is giyen by 
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and its velocity ''S^ and acceleration '^a^ are found to be 



^since the unit vectors are flxeddn xefeareace tome A. 
Defining generalized velocities . , 

U5=q5 »6=qfi . . . . 

. allows lewritLag Equation (50) ^. 

^u^a, +«fffli+uaa» -^tf*»i^i+j3sOa+^3 ^^^^ 
Tfac velaaties of the centeacs of jnaiases of the wheels axfr 
•foTxad to be 

• and &e accelerations of the ceuteis of masses of tiie 
i^heels are found to be 

There are three sets of forces actiag on this systcmMiie. 
appHed disturbance forces and torques applied to lefer^ce 
/ineBthatrcpresent, fee gravity forces actiag on the wheel 
and firame masses and th& motor torqaes applied , to the 

wh.eels. ' XT 

The disturbance forces acting at the origin of reference 

firame B is defined as . 



the gravity force on the frame is defined as 
or equxvalentLy as 



(55) 



(56) 



(57) 



and three gravity forces, which act at the center of the 
wbeds, are defined as 

Oji«-*»ff*i» O^^ms^z Gj^^—ms^s ^^^^ 
or equivaleutiy as 

d^^ms(^v^^^2+Z^i) ^^^^ 
The disturbance torque acting on the frame is defined as 

(60) 

and the three motor torques are defined as ' 
T^r^^^i T^^t'x T^^,b> 



with th& positive sens© of the toniue beLng applied to tfac^ 
wheel. However, Mewton* s second law dadnanda that there 
be an equal aiid opposite torque applied to the ftaxbc, body 
B, Thiis, t)io resultant acting on body B is given by 

The definitions of fhb generalized inertia forces was 
facilitated by droning the following tenns: 

The equations of motion axe found to be: 

[^-2^,>^4+C2i-^>iJ5H^-?ii>i^^ (64) 
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35 t:^-4Zu=0 

Since tiiexe are nine generalized coordinates, there axe 18 
equations of motioii, nine Idneroafcics and nine dynamic. To 
solve these equations numciically, they must be written, in 
^ the fojm 

. where fhe state vector y has the form y-{qi.. . . - , <1«» u^, 
45 , , . , u^}.Tfais necessitates reijmtLng Eqaatioa (39) to solve 
for the qi in terms of the The nine kinematip eqoationE of 
motion can now be written as 

50 . ■ ■ . . 

i7«iej QfttUS iff»W9 . 

To write the dynaimcxal cqnatioiis of motion in the same 
manner. Equation (64) must be solved for the u^. Since 
• several of the include u^, these temis will need to. be 
expanded. As a first stop, the following tenm are defined 

60 ^i9=Wi«3 2^««2«3 
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. Kt^-^j^ 

Kext, Equation (64) is rerwrittcn in the form Atir=Ki, thus 
providing a means for soivlng far the Uf, is given in 
Equation (68) and A is defined as 
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A discussion of tiie control system is presented in below. 
To sin?5>lify the equations of motion to facilitate control 
devcLopmcntj those tcims and equations tbat deal with tiie 
linear positLon^orce are eliminated because a gyrb- 
fftal>ilized platform can only counteract torques ^ not foarces. 
Rewriting Equation (69) as indicated yields 
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O • -(Z4.-H2mP) O • O -tTi 0 
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This equation can also be rewritten to explidtLy express 
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. wbcxel5«<3U^2rnl=')-l2, 

Arbitrary TOrqtic CSenciradoai From a Sphere 

Th.6 eqiiations of motion for the sphere, see BIG. 3, can be 
dedved from those for the three wheel device by noting 
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■ these two salient differences betweeaa the systems: the inextia 
^ ^ of the sphere is equal in all directions and is uncfaanged with 

orientations; and the center of ma-ss of the sphere is located 
h"^^ at the origin of ref eareiice frame B. The equatious of motion 

s . ^ for the sphere are given by; 
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Because the cxoss-coupHng tiixoagh the linear veloqity 
tcmos does not exist for tbis device, cGnfcroUiag a system thai 
dt^ioys this device for stabilizatioa is easier than control- 
ling a ■ system that crnploys three reactions wheals for 
stjabilizatiorL 

Control Issues 

Control theory is defined as a division of engineering 
amthematlps tliat attempts, through modeling, to anal3^e and 
t& coinmand a system in a desired mannec Of particular 
inlerest are dosed-loop systems. In a closed-loop system, 
the forcing signals of the system (caliihg inputs) are deter- 
lomed (at least partially) by the responses (or outputs) of the 
system* In this manner, the inputs and outputs are interre- 
lated. In K£G. 4, a gcncdc caosed-loop control system is 
shown. In order to e?cplain the contents of tiiis diagram, the 
following example is used: 

The objective ie to control the temperature of a room. In 
tbiB case» the sensor is the thermostat. The systcminput 
is set by selecting a temperature- Through edther some 
mechauical or clectdcal means, the difference between 
the deshred and actiiial temperature is calculated, result- 
ing ip. an crron If the actual temperature is. below- the 
desired* the compensator sends' out a control signal to 
the furnace (or plant). If the control signal eays'hftat on 
■ (actually, the electromechanical equivalent), the fur- 
nace outputs heat. This process continues, until the 
coii^>cnsator determines it is not necessary to heat the 
room, and the control signal is "changed to a heat off 
BignaL • . 
Control theory can be classified in two categories; das-'. 
Bical and modem. Cias^cal control theory is generally a' 
triai-and-cxxor system, in which various type of analyses arei 
used iteratively to force a electromechanical system to- 
behave in an acceptable manner. In classical control design,! 
the pecformance of a system is measured by such elements, 
as settling time, overshoot and bandwidth. However, for' 
highly corcrpleKt multl-lnput/multi-output (MIMO) systemsj 
entirely different methods of control system design should 
• be implemented to meet the demands of modem tedindogy.* 
Modem control has seen wide- spread usage witiiin the la8t| 
fifteen years, or so. Advancements in tcchnplogyt such asj 
faster camputecs, cheaper and more reliable sensors and the } 
integration of control considerations in product desigUj have 
made it possible to extend the practical applications of 
automatic control to systems that were impossible to deal 
with in the past using classical approaches- Modem control 
•theories are capable of dealing with issues sudi as perfor- 
mance and robustness/ the spatially-unrestricted force- 
feedback system makes use of two modem control design 
methods: distPibauce rejection and optimal controL 



1^ 

■ In the deslsn. of eLcctroipuscbani na 1 By stems, one can 
coniidef that tfac system vrfU be exposed to distuifaancos.. A 
disturbance may be dqfincd as? any unwanted input. la FXG- 
5, the ^Ustorbance, w(0> shoFwn as a. second inpat to the 
5 piaat Thei efieect of the distntbance ie added to the output of 
the plant- 

DistorBaiice rejection design, caa be used to cxeale a 
compcusatar wMcJb; is abLo to ignore disturbaiicc and 
cause the de^xed plant output la this sec^on, the basic 
10 method of disturbance x^ection design ie presented using a 
MIMO model. For this moddl, notatioa mtist be cstailisbcd 
to designate the various elements of the control design; let: 
[A* B» C, D] b^'la state-space representation of the plant 
(witii state x), assuming (A3> is con^letely coniibllable, 

IS • - • . ; 

xCt)B bo Hjo plant etato, 

ii(t)s 3^"' be the plant input <whcao ii| ia tho number of impute 
-and Ho 5* flae number of omputsX 
. 20 wC)6 be liie distnrbancci input 

3r(t)e "b* ^ dcsaixcd or icfbxtsxsso capnl 
yCt)s SR*** bo tbo Bcnsor oulpat 
e(t)e "be the tracking fcnor 
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The lumped MIMO linear, time^invaiiant system, 
may be cstpressed as: 

C75) 

The model for the input CBquationfi (76>-(77)) aaid Hie 
noise (Equations (7S)-(79)> are; 



The objectives in the design of the feedback system in 
FIG.. 5 are as follows: 
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aoscd-loop system must be csqjonentially. stable, 
Achieve asymptotic tracking and disturbance rejection for 
all initial states 

Robustness ' 
If -Qm is irae^ then for alL initial states of the system, 

55 eCt)->Oe 8C^ as t-^^'. \. . . . -r . 

Given the system [A3.G.BL suppose it is Tmmmal . Let 
. the compensator be given by 



60 i^^B^ • 

where 
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— cc^ — oe^a ... —at 
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Since and are known, [83] can be derived from the . 
equation 

■wibich i5 the least- conamon multiple of the characteaistic 
equations of and 

Under these conditions, if 

(which guarantees that the systeni is still completely 
controllable with the addition of the compensator) then 
The cocmposite system is coiEpletcly controllable 
Asymptotic tracking and disturbance rejection hold5 
AsyroptoHc trackipg and disturbance rejection are robust 
The discussion .contained here is establifihes a matiicqpoati- 
cal basis fox the invention. Control of a gyro-stabilized force 
feedback device is based on its ability to respond robustly tc 
a' control signal and to xespond conrecfly despite system 
noise. For &e Bijagle-inpufiTsingle-output (SISO) case, this 
theorem reduces* to the dassical control case where an 
integrator is required for robust perfaanance- Tfais result is 
used in the design of the 1I> cxperiinent whicii is similar to 
die classical satellite control problem- 

Optim^ control theory can be used to design compensa- 
tors which are able to take into account the cost of perform- ^ 
ing a particular action. A classical exan^le of optimal 
control is the use of fuel to maneuver a sateUite in orbit 
above the earth- Two extreme scenarios are possible: move- 
ment taking iminimum lime or movement taking mi nimim n 
fucL In the following section, discussion wBl focus on the 
fandaanental principles of optimal-control design, 
' The optimal control problem is to find a control u*(t) 
which causes the system x(t)=a[x(t), u(t)» t] to follow a 
• desired trajectory x* tliat miidmiacs the perfoonance mea- 
sure 

• ^' 

Otlxer names for J include cost function, penalty function* 
and performance index. Assume that the admissible fltatel 
• and control regions are not bounded^ (This removes alli 
mechanical constraints; these can he included in lated 
develcrpment) Let the initial states, ^(tciM?K>., of the systems 
and initial tLoie, t^, b© laxown. Also, let xe Eft" and ue Sl*^.. 
The goal now is to establish tote necessary conditions for) 

optimality: • , 1 

Assuming that h is diSereatiable and thai imhal condij 
tlons arc fixed and do not affect minimization^ [b 87] can bej 
expressed ias 
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5 • For generality, apply tbe chain rule and include differen- 
tial equation constiamts to foam an augmented cost function: 

. r • * CB9> 

-5 • using Lagrange niultipaiers Pi(t), _ . , p^(t). To sunplify 
the notation, rewrite D follov/s: 

" . • * • W 

The necessary conditions for qptinxal control can be 
dcuYcd using calculus of variations. Specificany, take the 
variatio^is of the fdnctfonal J^(u) tjy 6x, 5x, 6u, 5p and Stj. 
CDacrcmbnt of the functional J is defined as: AJ(x,. 5x>==5J(x, 
25 6xH«(x; 5x>-115x!|; 5 J is linear witii respect to 6x; Sx is called 
the variation, of the function x.) From this, &e necesaary 
conditidns may be derived: . 



F^C) ^ic^i^*C')r«Ht\p''Ct\^>'^ 

for.ail te[to, V], and 

^ r (94) 

where • „ ' " . 

. . KCxCt>,u(t),p(t>,t:^s(xCt)Mt)^(t\t)^^ 

The principles of calculus of variations are applied to the 
. . . design cf a linear regulator; The linear regulator is used in 
Itie control of the motors used to spin the inerdal masses to 
SO change the attitude of the sateiHte syBtem. The regulator 
design is particularly useful in comrolling unstable systems 
through "optinial pole placemciit. First, recall fee state equa- 
. tion of a linfcai^ time-varying plant: 

The cost function to be used is 

(97) 

where tJLt fixed, H and Q are real, positLve-fie^mi-defimte 
matriccs,-^d R is a real, positive-defiiaite matrix. The 
pmpose of the regulator is to maintain the state of the system 
65 as dose to a desired set of .pararoeteErs as possible wltfciout 
excessive control effort The necessary conditions far opti- 
xuaHty to be used axe: - ^ f ' ' . . 
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where the HamEltonian is defined as ' 

K(<Oi -K^. KOr 1- ^C>fi«KO «Ht)RCO«<0-»- . V. 

• * J^(OA(^M^+i'''(»•W*K=0■ 
EquatioIL (100) is easily salved for the optibmal input far 
the regulatox, yiddLng 

It is now passible to form an augmented, closed-loop 
state-apace equaiioa of the regulated system; 

. r >(er 1 r A«p -^c^ if-Kf) 5^co 1 r ^^f*^ 1 . 

These 2n differential equations have a solatioix of the 
form; 

Note: <|>(t^,t) is called the transiiioii matrix, define by 
<i/dt4)(t^t>=A(t)4>(tf,t) with the initial condition of t|)(ta,to)=a. 
and is solved through numerical integration. By partitioning 
the state transition hiairix, 4i(tf,t), the following solution for 
p*(t) can tre reached; . 

Therefore, the optimal control la^ is 

the next step is to define a nnethod of solving for K. This 
is adiievcd.- ufiiQg a Riccatt-type' diffcarential cquatiom 

which involves solving n(n4-l)/2 first-order • differential 
^ equations. Fartanaiely, the motor system invqlved in the 
hand controller control system can b6 considered thne 
invariant. This Bhnplifi.cs the previous eqiiatioas, which can 
£>e summarized as: 

^e{i>=vU<^jB«<F) <l-^) 

(i09)| 

J « 1 [x^coo^O «^COfi«Cr)l^* 



and the optimal control law is 

u'Ktf^K^£^'^^(^^6- ^^^^^ 

As long as Q is positive definite, the closed-loop syistem 
is guaranteed to be stable and the controller may be used for 
pole placement design of the system, as shown in PIG. 6. 
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optiBuUly based on tbe ^^^f^ °5 
seS-oie=r^to^ .n«kloLI^ disturbance rcjecbou. zb 
augmcdited in ttiR control system for robusC?ess. 

fcJEiix . ' 

^ wheie a(t) Is the anguto acceletailoa. Vis the inextial 
mass, and i(t) is the torque. 

Since the stabiHIy of tins system is (at best) in^ginal. a 
«ofe otaca^S is petfoxmed- Ito&er, optimal mefeods «oce 

plant v«ll follow the model 3^ EIG. «• °P^^ 
desi^ will give the "best" values to use for and K.^ 
•Tn,« first meo is to tihcKise the cost fuDcaion to lainimize, 
30 set^€StSoas.and.eioctthen=cessaxy<^^tio=^ 
boiSdary conditions which apply to this probl^a. Let tfae 
SSStes of flie satellite bezero: x(0>=0; i(0>=0: -Hxe cost 
fahdion for mininial control effoart IB 

35 ("3). 

snch that liie amount of accelccation of iixe sy^tcin, 
40 «*Ti£r ft fc S:.silive or negative, f or aU time ds mnnm^ 

■ i the maenituiic of the control iaput. or for 

Z ^^Si^t^Sel. Whiohis alian^ ^source. For 
Sr^tem, tfae faUovring paranicters are taiown: 

* with a state defined by , - 
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and ctioosc 
Q 



and R^l. -, ^. ' 

For the LH Ricatii equation, [1101, K has foor sduhons 
•but the only positive-definite solution IS 
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which results in a regulatoi:, F. of ihe foUowing form: 




(U8> 



■nie tivo termB of the F vector arc the ppsltton feedback 
and vcaociiy fcedbiok xcquii^^d for optimal trackmg, as m 

^Tlie "final step Is to indudc an iJitegratar which provides 
the SKO case^vilkrpfaiiBtDesSvThe&ial controlJcc designis 

There are some control issues that are ^ccific to &e 
^^uxs^ wheel concept. These issues are those &^de?d 
3a detenniidUg fee state of the sphere, which must be 
^own to ejaculate the sj^erc's angular momentum vectoc . 
S i£ nature of a sj^cal object allows It to teat w 
^e^onietative to it's cavity, aiaethod that can d^cj&e 
^hS exact orientatLonrelafiveto the three fixed orfhogo- 
S^s sphere hou^g is used. This is HhisU^ted in 

^EkcW the 'three Sphcic housing pris is outfitted ^vi^ a 
ba^ of optical infcired emitters to detect :the relative 
SSi^a cSe sphere. Each emitter 

wo for more) infra-red detectors as shcjwn on FIG. IX. "nas 
tec^Sue Wfll enable fine position sensing 
^ously minimize power reqmrements smcc a smglc cmlttar 
■will service' two (or more) detectors. 

^ITie sphere is equip3?ed wlfli a single great CHole band of 
xeS:ttvrSLrial as illustrated in EIG. 13. As shown in 
S each sensor band on the ^hcre Boufing cavers one 
of fl^e great circle band on each sphere honsmg bxxb 
Sisiaeut^ the reflective band is always within mnge 
S^^toee optical, emittet/detector pairs regardless of 

^S:5^?ieteclx«: seusors are loc^ dUccOy on ti« 
cavS? feceTsuimlify consfcmction of the sphere housmg. 
^toex aStekor is directly interfaced to ihe hous- 
a fiber optic cable that ends at a 1ms mounted 
^tSS^facc as shownin ETG. 14. Using a lens penults 
filfe use of lower power infra-rfcd cimttcrs. , . - 

LSmSs. IS.Iheinflra-iedeimtters are dnveuby 
an^uStTit from me Sphere Control Con^uter. Adtoss 
d^t^logic and latch bits contahied in the Sphere Control 
fc^sSl^de emitter data from me cont^;-^^ 
aad torntoe appropriate IR emitter on. The control comp^ 
^dSe assldlt^lRxeceiver, via tixe same decode. mul- 
S»Sor logic in the Sphere Conaol Subsystem. 

Conventional Applications to Spacecraft 

There aretwointcr-rctot«ii^ncihe8 ^^J^^^^J^ 
usSto spacecraft control: celestial raediamcs and attode 
™^^?s^ farmer deals wilii Uie position and velocity 
.^e^nJo^mass of the spacecraft as it traveU ttaough 
Z^, Whereas the latter deals with ^J^^-- °f 
fiSacecraft abaat its center of iiiass. see FIQ- a*- 

Attitude mechanics is divided into ifaiee componMts: 
4e^£loh, predictioa and conhrci. AUil^de^^na. 
toais the process of con?3tttlngthe 
. ^a^=aft%rtth respect to some specified mertial frame. 
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Attituiie predictioiL is the process of coibi)Utlng the futurfc 
, attitude of th.D spacecraft based on its ctmrent state and 
■ anption; Attitade coBtrol is the process of applying tos^gues to 
.the spacecraft to reorieiit it into some desired fiiblre state. 

5 rrhe 6&vicc£ mentioned in this patent deal pri.Tnartly with the 
control aspect of attitude mechanics. 

For most modem spacecraft applications, three-axia. con- 
trol is.requh:ed« This method of control allows' mission 
planners to specify Hxe orientation of the spacecraft at aU 

jQ times during the couxse of a iDissicm. Missions that employ 
this type of control include aU commuzucaUons satellites^ the 
Spacb shuttle and earth-^orblting sciontific satellites. 

lb functicl^ -properly^ three axis stabiUzed spacecraft 
employ sensing devices that identify the spacecraft* b attitude 
by d^teaniaing two mutually perpendicular orientatibn vecr 

^ tors. Sonde typical examples int^de two-axis sun sensors 
and magnetic field sensors. Once- the spacecraft's attitude ife 
dstenoined, the mission profile determines the control 
reqnirements- Certain scienti&c satellites require extremely 
precise attitude control (arc-sccpnds) for the purpose of data 

^ collectLoa. Others^ such as C-band televisipn satellite, 
•require less precise control (arc-minutes). Since all satellites 
• are subject to disturbances, some method of maintaining 
prcrppr cdLentation is required. 

Hicxe are three primaiy mjeans for controlling a satellites 

^ attitude: gas jets, electromagnets and reaction wheels. Ricac- 
tionjets operate by expelling gas through an oriftce to iir^art 
a mcfoicnt on the spacecraft These deviciss can produce large 
. (but imprecise) torques, but since they Gspend fuel, Ihcrc 
on-statLon operating lime is limited. Blectrooaiagnets opesraie 
by creating magnet fields -that interact with the magnetic 
field of a neaiby body to produce a toarque on Ih-e satellite, 
Althbugh these systeras do not expend fuel, Ihey only 
function near bodies with- large magnetic fields. Reaction 
wheels operate by way of Newton* s third law by accolcrat- 
iixg £^ wheel to absorb torque that is applied to the satellite. 
If the applied disturbances are- cyclic, these systems can 
opsritte indeanitely since there is not net gain/loss of energy. 
For real-world systems, reactioii wheals typically operate in 
conjunction with gas jets, which arc used to bleed off excess 
monientam. the wheelfi approach their operating condition: 
boundaries* Reaction wheels prb\dde a very fine degree of 
attitude coritroL 

Applications for Platform Stabilizatioji 
45 V?hat differentiates space-based applicatiions from other 
applications is not the lack of gravity but ralher the fact that 
gravity is tlie same in all directions. Sinoilar sitnations can 
occur on the Earth: system with neutral buoyancy in a liquid 
.and systems that are fixed in &lc direction of gravity operate 
50 under simiiar principals as space-based systems, see KEG. 
17. 

For cdcample, consider the case where a sensor platform is 
to collect data firom a lake over a period of ttme. If this 
platfonn is required to xnaintain a. paiticxilar attimde, a 

55 gyroscopic system can be used for stabilization. Simolncly, a 
semsor; platfonn mounted on & research baEoon may bo 
required to T^^i-r^+tt-tn two-axis atdtudj? control for the dura- 
tion of the mission, Again> a gyroscopic system can be used 
to stabilize the two rotational degrees of fireedom of this 

^ systezn. 

EXAMPLES 

Two sets of exgpadrneats were carried out with the single 
degree of freedom device. The first expcziraciLt was intended 
6S to. validate Equation (119) • A second experxment was 
- intended to demonstrate a control system for a three DOF 
system. ^ .■ ■ . ■ : I 
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To carry, oiat tlics^ tests, a test stand Was dcvdojicd, as 
•flho\vn. in HIG. 16, ^ . 

This test setup conaists -of the foUpwing cotxtponents: 
A turntable with an attached motot. The positiou of the> 
tuxntalile is instrumented with an mcaremental encoder 
attached direct^ to the turntable (not used in this: 
experiment). The position of the motoi: shaft was not 
instrumented, however, its angular vdociiy is instro- 
mented. The motor eaigjioyed is a Hathaway model 
1500, attached to the toomtable by means of an adaptear 
block. *^ 
A momotttum wheel attached to the motor shaft. This 
momentum wheel is maniafactufed £rom a piece ol 
stock, 2 inch diameter, cast iron shafL. 
Tfec motor is attached to a Cyberlmpact® Inielligent , 
■ Motor Controller . (IMC) system, a standard Cy*bcxnet i 
product and is used with, all of our farce feedback 
devicscs, wljicii. provides an interface to a PC based 
controlier that allows for . a wide range of .motion 
commands, to he progranomed, 
Ttoie IMC is attached to a PC In this pxampilci a sinLaple, 
previously developed intoifacc to start and stop the 
motor was employed. This interface" presents the user 
wittL an input screen for directly controUtag the motor 
current- By setthig- the cu3crent to its maximum allow- 
able value, the maximum obtainable torque is observed. 
By setting the current to zero, the motor comes to a '• 
stop. . 
A torque measuring system consisting of a spring and a 
camera. Applied torque was nieasured by. tbo displace- 
ment of a known ^rlng and the time for this to happen 
by counting video feames. 
The position, velocity, and/or accdcratioa provided on a 
user-interactable member is sensed and transmitted as a 
command ^to a computer model or simulation which imple- 
ments a virtual xreality force field. In turn, the force field 
.value for the given position, velociiy, and/or acceleration is 
sent back to the member, which generates a force command, 
thereby providing the user with direct kinesthetic fpedback 
from the virtual environment traversed, Ataioiigh applicable 
to conteolllng a virtual car simulated environment, the tech- 
nology is also well suited to the control of a remote or 
physical device. Further, the present invention is saitcd for 
application to any number of axes. 

The cperatibn of the IMC system andPC interface will be ' 
best understood by referring to commonly assigned U.S. Pat, 
Kos. 5389,865 and 5,459382, andpending applications Ser. 
Nos, 08/513,488 and 08/543,606, tiic contents of cacdi^of 
which are incorporated herein in ^eir entirety by reference. 
These patents and co-pending applications describe systems 
and methods for presenting forces to an operator of a remote \ 
device or to a user interacting witii a virtual environment in , 
multiple a5:es fiiinultaneously mediated through a computer] 
controlled interface systan. which provides a position, 
velocity, and/or accderati'on (to bo referred to geaierally as j 
*fo^ce**) to a user interface which, in. tmiu generates an 
electrical signal 'for eac^ of a pluraiiiy of degrees of fccc- 
dom- These electrical signals' arc fed to a virtual reality force 
field generator which calculates ' force field valufcs for a 
selected force field. These force field values are fed to tbe 
force signal generator which generates a force signal for 
each of the plurality of degrees of freedom of the uscx as a . 
functioa of the generated force field. These moiion com- 
mands are fed back to actuators of the user interface which 
provide force to thb user interface and, thus, to the user in 
contact with the interface device. 
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Before discussdjag these appIicatLous in fmthar detail^ a 
tiackgroimd -will be provided with, respect to inertial stabi- 
lization as its relates to reactLon wheels and space-based 
applicatioris, as ^cextain -pciaciples of spacecraft platfprm 
I stabilizatipu have, for the first time according to thi^ 
' inveiiiio2x» been applied to spatially unrestdcted texrcstxial 
control* 

Hxperimental Data for ID Device Tmpl ramentation 

Since a loiowa snomeatum wUeel was nsed^ tbie' form of 
BquatLpu (29) is not quite ri^^t for &is expedment. Instead^ 
this eguatioa is rewritteii as . . 

wrap ^19) 

15 ■ . 

wbearp the factor of two is used because a solid dislc, not 
a tVit-n hoop, y/as used. The roass of the moraentum wheel is 
0,277 leg (measured) and the Inertia of the motos- rotor is 
20 ignored. 

Using the motor electrical parameters and tixe dectdical 
characteristics of tbe IMC chassis, the zoaxiimmi torque that 
can bo applied by the motor is Uown tb be 0-18 Nm. 



10 Inserting these values into Equataon (119) yields a ttcne of 



gQ ■ - 25 0-09 seconds. 

m 



To measiKe the torque, a spring with a spring constaiit 110 
. >?/m. was attached to the adaptor block fay way of a bolt, at 

5 y a. distance of 0-050 m from the center of rotation. Since F==k3t 

* andnc=^d,these terms can be relatcdin the foUowingman^ 

^' 30 " 



^w" Of cpurse, the equations used are very primitive and dp 

tf\ not account for many of the real-world ajffectfi. Th& affects, 

^ g ' . which primarily fdctive in nature, should tend to make 

the displacement less than predicted and the time -greater 
h** than predicted- The results of these experiments are shown 

r J in l^rQ. 19 and FIG. 30. The ,pictore on the left shows the 

* system just before cmxeiit is applied to th^ motoin The 
picture on the right shows the system at maxixoum spring 
extension, whidi occurred five video frames, .at. 30 firames 
per second, latei. The results show a dlisplacement of 1*2 
inches (0.030 m) and a time of 0.16 seconds. Given the 
expeximental setitp, these xesults.are well within the range of 
'^^ experimental cixar, thus giving credence to the modcL 

Bxpcximcnts were also performed to control the position 
of the tomtable, in the face of disturbances, by controlling 
the speed of the momentum' wheel .The equations and 
methods used to develop IhiB control scheme wexe discnssed 
previously. For this expedment, the same sctiipJ was used as 
for the previous experiment with several small omodifica- 
tions: 

' The instrmnented readings from the turntable and the 
. S5 motor shaft were used by the controILci: 

Tho spring was removed from the escpcrimcntal setup. 
A control program was written ittat interfaces direcdiy 

with the IMC system. 
Using M/^TLAB, which is a jpC based mathcnaatical tool 
60 designed to aid, cnghiecrs in the development of complex 
mathematical systems, the controller and plant were simu- 
lated. Siuce the amount of control input is not a particular 
conceoi, qpthnnl control paramgters were selGCted to pro- 
duce a systeih that responds quiddy. In the fallowing 
65 expcEirnents, the values ^=qa==10 and R==l were scdcc^ 
select an appropriate value fos Ihe disturbance rejection gain, 
a root locus plot of the system, FKx. 21, was dev&loped. 
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Bram tfcns diagram, the gain of 1±ic system, which, is selected 
to produce fiast responso time, has value of approxixcmtoly 
133xlfr^. The respoase of the system • of a unit step 
disturbance is shown, in. KEG. 22 (plot • genexated &x>m 
* MatlJab). These parameters were tliea used in testing* a xeal 
model Cif tbe system. 

The contral parameters determined, asmg. the optimai ! 
control techniques and the root-locus method were applied 
to the system' shown in HIG. 18 (without the ^pdng). Since 
the . control eqaations xegnire the momLpnt of injsrtia of the 
platform, CAX) tools wexe used to calculate moment of 
it inertia of the motot, the adapter plate and the bolt. One itexs 
' that was not modeled in the eiixmlation, or the calculaiions 
for determining control pazameters, was the friction in tit 
system-. 

Id. this particular device, there was a great deal of Cou- . 
lomb friction in the ba^e bearing. The components mounted' 
to ttie base would hot complete a single rotation before 
coming to a halt after an initial spin. This has the effect of 
adding instability to the system. In particular, what tends to 
happen is that the system will stay at some point for some 
pdiod of tfrrie while the integrator error (the disturbance 
rejection) adde up. At some point, there is sufficient energy 
to overcpme the static fidction, which is less than the 
dynamic fdctioru Once moving, the system will tend to 
overshoot the deshred point and try to compensate, but the 
same sequence of events occurs, 

EKj. 33 shows actual data from an ^iipermient to control 
the physical device. Despite the Mction prolblen^ ithe results 
£rom this test are as e3?pected. The. system does oscillate 
about the control pointy though it is quite noisy. 

An cxpenmcnt was also performed to determiae if the 
forces generated were noticcabie by a human. To perform 
ibis eacperiment, three motors with momentum wheels were 
mounted onto the adapter block used in the previous expcri- 
ments. 

The mjotore were spun up to a speed of 5000 RPM. 
Individuals were asked to handle the device and to make 
subjective evaiuations of the torques felt as the device was 
moved about; In all cases, the subjects reported feeling 
appreciable forces that were deemed to be sufficient fczr 
carrying -out meaningful tasks. A. picJture of the device if 
shown in PIG. 24. * • 

The torques felt were gcncxated because the control^ 
system had' been comihanded to maintain the momentum 
wheels at a constant angiiLar velocity. By moving the device 
about^ the angular momentum vectors were ch^ged^ thus , 
causlzLg a torque. The control system compensated fot these 
motions by adjusting the output to the motors. Since the 
rhotors wiere already spinning at high speed, the period of 
time for which a torgue could be applied was far more 
limited thqn for the case where the motoor is initially at rest. 

Having demonstrated that forces can be generated in any 
direction, the fUial taak . is to control the motors in an 
appropidate manner so as to provide haptic feedback to die. 
user. This taslcretjoires a sophisticated control algorithm for 
two reasons: Acst, the platform, wiil be grossly displaced 
ficom its aominai^ operating orientation, arid second, for any 
motion of the platform (for simplicity consider just rotations 
about tbe wadd coordinate axes with which the deyice Is 
initially oiiehtcd), some subset of the miotors will produce 
torques (due to changes in the orientattan of the angular 
momentum vectors) -that are undesired. To counteract these 
undesired torques, some subset of the motors will need to be 
accelerated to produce counter torques. Tlie control sy istcm 
must model the full, non-line^ dynamics of the system^ 
have a high speed attitude sensor and possibly a control to 
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snioo£bly generate th&presadbed forces. A block diagram, of 
the system is showu in HtG, 25. ^ 

AppJicatioas 

As discussed above, one family of applications for tiic 
devices described, above utTliyes inputs receaved from a 
virtaaj environment For this type of application, Qie virtual 
envirdninent inoddUs same set of obj ects, and hand controller 
op: other force--xie£f.ectLon device produces forces that are 
•xcprespntative of some activity, \\dthiii the virtiial ejrsAron- 
xncnt Since it is not required that the forces produced 
corrd^to to »ny| specific activity, the oxHy XMtrictioii placed 
on the commands sent to the gyro-stabilized device is that 
the ott^utfoxccs be within the range of forces that the device 
call prddiice. An alternative famUy of applicafionfl for these 
devices produces f C3g:cBS in accordance with inpirts received 
firoia'a (possibly remote) .physical device. For this type of 
applicatLon^ the forces prodnced are typically a scaled xcp- 
resentation of the actual farces pocpduced at some point on 
the actual physical device. To provide tiiB ^widest range of 
haptic inpnt, the scaling is typically designed such that the 
maximrtm force that can be applied to the physical device is . 
mapped into the maximnm force that the haptlc device can 
produce. 

To the first onlcr, Ihe devices desciibed ai:e marginally 
stable at best To control these devices to produce desired 
tprque oiuputs in the face of input disturbances, a two step 
controller is preferably ntOized. The first step stabilizes the 
controller by doing a pole placcraeat. The locatioa of the 
poles can be detenxdned using any applicable method 
although optimal control is prefeaxed. The second step 
creates a robust controller by canceling- out disitnrbance 
inputs.- Robust control theory is appUed for this taslc 
35 WS&i spcciflc regard to platform stabilization, the desired 
input is typically a zero input, i.e,, that the system, should not 
change state. For these applications, sensor are employed to 
determine when t|ie system changes state due to distcir- 
' banpcs and the controller acts to return the systend to the zero 
state. ' 
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Unloading 



The hnman opcratar who controls the haptlc device is, * 
from the perspective of the momentuni device, equivalent to 

45 group. Although any amount of angular momentum can- be 
removed &ota the device when it is coupled to ground, since 
this is a haptic device,* the strategy is to slowly and con- 
tinually remove angular momentum so as to have as miijimal 
aiffcct on the nser as possible. In particular^ the momentum 

50 sphere has a msxiranm speed at whida. it can operate due to ' 
the materials and .construc^on techniqueis employed. When 
the sphere approaches this maximmn velocity, momentum 
must be unloaded ficom the sphere for it to continue to 
function. To do this requires the application of an extexnal 

55 torque that will cause the angular momentum vector to be 
diminished. This can he accomplished in three ways: reac- 
tion jets, mag:nctic field Ixicqucrs and/or spacecitaft reoriea- 
tatlpn. The first two methods wort: by applying a torque to 
the spacecraft ^at diminished the angular inomentum of the 

60 sphere. The third method works if the following two con- 
ditions are met: the distuibances to the spacecraft are 
prixQBilly BpplQjed in the same direction and the spacecraft 
Can continue to operate at different attitudes. If '^ese •con^- 
ditions are met, the spacecraft can be reckiented srach that the 

65 disturbance torque act to cancel the sphere* s angular 
momentum. It may also be feasible to rigidly couple the 
platfoxm to ground for a brief peood'of time. Wtiile coupled 



